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Using  Direct  Methods  for  Terminal  Guidance  of 
Autonomous  Aerial  Delivery  Systems 

Oleg  A.  Yakimenko  and  Nathan  J.  Siegers 


Abstract — This  paper  discusses  the  usage  of  direct  methods  of 
calculus  of  variations  for  real-time  optimization  of  a  final  turn- 
into-the-wind  maneuver  for  autonomous  guided  parafoil-based 
delivery  systems.  It  reviews  several  approaches  that  are  currently 
being  pursued  by  different  developers  of  such  systems  and 
discusses  the  necessity  of  usage  and  applicability  of  a  direct 
method  to  optimize  the  final  turn.  The  proposed  approach  seeks 
for  an  optimal  solution  within  a  certain  class  of  parameterized 
inertial  trajectories  and  further  employs  inverse  dynamics  to  find 
the  corresponding  control.  This  approach  has  been  successfully 
used  in  a  variety  of  real-time  applications  already  and  proved  to 
work  well  in  a  developed  miniature  aerial  delivery  system, 
Snowflake,  as  well.  The  paper  presents  the  results  of  the  most 
recent  real  drops  and  ends  with  a  discussion  of  the  developed 
algorithm  as  compared  to  another  one,  pursued  by  Draper 
Laboratory,  where  instead  of  parameterizing  a  reference 
trajectory  the  control  itself  is  being  parameterized.  The  paper 
ends  with  conclusions. 

1.  Introduction 

URING  the  last  decade  there  were  many  efforts  to  replace 
old-fashioned  uncontrolled  circular  parachutes  with 
maneuverable  autonomously  guided  ram-air  parafoils  that  can 
assure  more  accurate  delivery  of  a  variety  of  payloads  from 
high  altitudes  and  large  standoff  distances  [1]. 

Autonomous  parafoil  capability  implies  bringing  the  aerial 
delivery  system  (ADS)  to  a  desired  landing  point  from  an 
arbitrary  release  point  using  onboard  computer,  sensors  and 
actuators.  The  navigation  subsystem  of  the  guidance, 
navigation  and  control  (GNC)  unit  onboard  the  ADS  manages 
data  acquisition,  processes  sensor  data  and  provides  guidance 
and  control  subsystems  with  information  about  parafoil  states. 
Using  this  information  along  with  local  wind  profiles,  the 
guidance  subsystem  plans  the  mission  and  generates  a  feasible 
trajectory  to  the  desired  landing  point.  Finally,  it  is  the 
responsibility  of  the  control  system  to  track  this  trajectory 
using  the  information  provided  by  the  navigation  subsystem 
and  onboard  actuators. 

A  variety  of  different-weight  ADSs  were  developed  and 
demonstrated  during  Precision  Airdrop  Technology 
Conference  and  Demonstration  (PATCAD)  in  2001,  2003, 
2005  and  2007  [2,3]  in  the  U.S.  and  Precision  Airdrop 
Demonstration  Capability  (PCAD)  2006  and  2008  [4]  near 
Bordeaux,  France.  Analyzing  the  results  of  dozens  of  airdrops 
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however  it  can  be  stated  that  practically  all  systems  have 
difficulties  meeting  their  circular  error  probable  (CEP) 
accuracy  requirement  (established  at  75m  for  the  lightest 
systems,  below  15kg,  all  way  up  to  300m  for  the  19-ton 
systems).  The  major  reason  for  that  are  unknown  and  variable 
winds  near  the  ground.  It  is  relatively  easy  to  bring  the  system 
close  to  the  target  (usually  upwind),  while  an  altitude  reserve 
still  exists,  but  it  is  quite  difficult  to  decide  when  to  exit  an 
energy  management  (EMGMT)  pattern  and  actually  fly 
towards  the  target,  especially  aiming  at  landing  into  the  winds 
(for  soft  landing). 

This  paper  specifically  concentrates  on  the  terminal  phase  of 
a  guided  descent  and  is  organized  as  follows.  Section  II 
presents  some  of  the  known  strategies  and  advocates  the 
necessity  of  real-time  optimization  during  the  last  portion  of  a 
descent  to  mitigate  the  effect  of  changing  winds.  Section  III 
presents  general  ideas  of  the  direct  method  of  calculus  of 
variations  as  the  only  tool  to  handle  real-time  terminal 
guidance  optimization.  Section  IV  proceeds  with  a  detailed 
derivation  of  optimization  algorithm  based  on  the  inverse 
dynamics  in  the  virtual  domain  (IDVD)  method.  Section  V 
describes  the  miniature  prototype  of  a  generic  ADS  that  was 
built  and  extensively  tested  with  the  developed  algorithms 
followed  by  the  results  of  the  most  recent  drops.  Section  VI 
introduces  and  discusses  a  slightly  different  approach,  still 
based  on  the  direct  method,  recently  proposed  by  the  Draper 
Laboratory,  followed  by  Section  VII,  which  compares  two 
approaches.  The  paper  ends  with  conclusions. 

II.  Terminal  Guidance  Strategies 

Usually,  industry  does  not  disclose  control  algorithms 
employed  on  their  systems.  However,  some  of  the  ideas  can  be 
easily  picked  up  by  analyzing  the  test  results  (if  available).  To 
this  end,  Figs.l  and  2  present  a  bird-eye  view  of  typical 
trajectories  of  different  ADSs  (demonstrated  at  PATCAD  and 
PACD)  that  are  trying  to  steer  towards  a  target  (the  authors 
tried  to  pick  the  best  ones  among  those  that  were  published). 

To  start  with,  some  of  the  systems  employ  either  way-point 
navigation  or  some  kind  of  heuristic  algorithms  that  mimic 
behavior  of  a  human  jumper.  As  seen  from  Fig.l,  it  may  lead 
to  not  only  missing  the  target,  but  also  to  a  failure  to  land  into 
the  wind.  Once  again,  the  major  reason  for  this  is  always 
unknown  winds  below  the  altitude  the  ADS  is  currently  at. 

Figure  2  presents  another  approach  pursued  by  three  other 
companies.  They  bring  their  ADSs  to  the  target  and  further 
spiral  down  trying  to  keep  it  in  the  middle.  At  a  certain  altitude 
(based  on  an  estimate  of  a  current  velocity)  the  algorithm 
commands  to  exit  a  spiral  towards  the  target.  Theoretically,  in 
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this  case  a  miss  distance  is  roughly  limited  by  the  radius  of  a 
spiral.  However  in  practice,  the  ground  winds  take  their  toll 
and  may  steer  a  system  further  away.  It  is  especially  true  for 
the  two-stage  Screamer  ADS,  when  at  a  certain  altitude  a  main 
round  chute,  bringing  the  system  down  to  the  ground 


uncontrollably,  deploys.  Of  course,  neither  of  systems  attempt 
to  land  into  the  wind.  (It  should  be  noted  though  that  this 
moth-pattern  algorithm  could  be  easily  modified  to  allow 
landing  into  the  winds  [5].) 
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Fig.  1.  Examples  of  a  flight  path  of:  a)  Panther  ADS  (by  Pioneer  Aerospace  Corp.  /  Aerazur)  [2],  b)  Sherpa  ADS  (by  MMIST,  Inc.)  [2],  and  c)  SPADES  ADS  (by 

Dutch  Space)  [4]. 


Fig.  2.  Examples  of  a  flight  path  of:  a)  Mosquito  ADS  (by  Stara  technologies,  Inc.)  [1],  b) 
Onyx  ADS  (by  Atair  Aerospace,  Inc.)  [2],  and  c)  Screamer  ADS  (by  Strong  Enterprises)  [2]. 


payload  delivery  [10].  Recently,  it  was  applied  to 
terminal  guidance  of  ADS  [11]. 

In  what  follows,  we  first  consider  the  general 
ideas  behind  using  direct  methods  in  flight 
mechanics,  followed  by  the  approach  and  results 
of  using  IDVD  for  ADS  final  turn  optimization. 
Then  we  will  come  back  and  review  a  Band- 
Limited  Guidance  (BLG),  put  forward  by  Draper 
Laboratory,  from  the  standpoint  of  direct  methods. 

III.  Basics  of  Direct  Methods 

To  approximate  the  Cartesian  coordinates  of  a 
vehicle  and  its  speed  (four  states).  Prof 
Taranenko  suggested  using  the  following 
continuous,  unequivocal  and  differentiable 
functions  [12] 


Since  it  is  well  understood  that  terminal  guidance 
determines  touchdown  accuracy  it  is  crucial  to  adapt  the 
guidance  algorithm  (computing  a  reference  trajectory)  to 
changing  winds,  i.e.  to  allow  constant  real-time  re¬ 
computation  of  the  final  turn  maneuver  to  accommodate  wind 
disturbances  as  much  as  possible. 

One  such  attempt  realized  on  large  systems  was  a  GNC  unit 
developed  by  Draper  Laboratory  [6,  2].  Being  unable  to 
optimize  a  maneuver  in  real-time,  an  optimized  table-look-up 
terminal  flight  path  was  chosen  based  on  the  current  conditions 
while  entering  a  terminal  area.  This  approach  was  not  robust, 
and  lead  to  the  latest  development  using  a  direct  method  of 
calculus  of  variations  to  be  able  to  produce  a  quasi-optimal 
trajectory  in  real  time  [7]. 

It  turns  out  that  direct  methods  have  been  used  in  flight 
mechanics  since  the  60s  [8].  Specifically,  the  IDVD  method 
[9]  was  recently  used  for  a  variety  of  real-time  applications  for 
unmanned  underwater  and  air  vehicles,  rotorcraft,  spacecraft 
and  missiles.  Also,  it  was  suggested  to  be  used  for  coordinated 


X,.  (r)  =  ( r  -  To )  +  <D .  (r) ,  /  =  1,...,4.  (1) 

Tf  —  Tq 

Obviously  these  functions  automatically  satisfy  initial 
conditions  (IC)  x.(Tq)  =  x.q  and  terminal  conditions  (TC) 
x.(r^)  =  x.^  as  long  as  O.(rQ)  =  d).(r^)  =  0  .  As  an  argument  z 

any  monotonically  changing  parameter,  e.g.,  time,  path,  full 
mechanical  energy,  etc.  can  be  used.  However,  to  decouple 
time  and  space,  Taranenko  suggested  using  virtual  arc  as 
oppose  to  time  as  an  argument.  The  so-called  speed  factor 

(2) 

dt 

allows  to  map  the  virtual  domain  to  the  physical  domain. 
Functions  0.(r) ,  depending  on  several  varied  parameters 
,  ^  =  0,1,...  define  a  variety  of  candidate  trajectories,  and 
their  choice  depends  on  a  specific  problem.  In  general,  the 
more  terms  (varied  parameters)  the  functions  0.(r)  have,  the 


2373 


0.  A.Yakimenkoand  N.  J.  Siegers:  Using  Direct  Methods  for  Terminal  Guidance... 


TuB2.3 


more  accurate  (closer  to  the  really  optimal)  solution  can  be 
found.  Some  unknown  coefficients  a.j^  can  be  found  using  the 
boundary  conditions  (BC)  imposed  on  the  first  and  higher- 

d^x. 

order  derivatives  = — j-  ,  1  =  1,2,...  ,  while  other  (free) 

dr 

coefficients  become  varied  parameters  in  addition  to  . 

Once  the  Cartesian  coordinates  and  speed  are  defined  using 
reference  functions  (1),  the  remaining  states  and  controls  are 
determined  using  inverse  dynamics  of  the  original  non-linear 
equations  driving  the  system’s  dynamics.  All  the  states  and 
control  history  are  then  mapped  to  the  time  domain  using  (2). 

Taranenko’s  direct  method  has  a  huge  advantage  over 
indirect  methods.  As  known,  in  classical  optimal  control  the 
problem  is  reduced  to  determining  the  trajectory  with  the  given 
initial  states  and  control  time-histories  by  solving  the  Cauchy 
problem,  i.e.  integrating  differential  equations.  Taranenko’s 
direct  method  in  general  does  not  require  solving  the  Cauchy 
problem.  Instead,  having  the  desired  trajectory  from  the  very 
beginning  the  inverse  dynamics  is  applied  to  retrieve  time- 
histories  for  all  the  controls. 

Another  approach  could  be  to  start  from  parameterizing 
controls  time  histories.  However  in  this  case  the  Cauchy 
problem  will  need  to  be  solved.  As  a  result:  i)  the  TC  will  not 
be  satisfied  automatically  as  in  (1),  ii)  integrating  equations  of 
motion  will  significantly  slow  the  optimization  routine,  and 
finally.  Hi)  the  convergence  is  not  guaranteed.  These  are  the 
pitfalls  of  the  BLG  approach  as  will  be  discussed  in  Section  VI. 

Prof  Taranenko’s  approach  was  further  advanced  and 
perfected  in  IDVD  method,  specifically  designed  for  real-time 
applications  [9].  The  details  of  its  application  to  terminal 
guidance  of  ADS  can  be  found  in  [11].  For  consistency,  the 
following  section  briefly  repeats  the  main  results. 

IV.  Inverse  Dynamics  in  Virtual  Domain 

In  an  attempt  to  mitigate  the  effect  of  unknown  variable 
winds  we  run  into  the  following  two-point  boundary-value 
problem  (TPBVP)  (Fig.3).  Staring  at  some  initial  point  at 
^  =  0  with  the  state  vector  defined  as 

Xo  =Eo>>’o>t^or  (3) 

(x  -  downrange,  y  -  crossrange  and  y/  -  heading)  we  need  to 
bring  our  ADS  influenced  by  the  last  known  (estimated 

onboard)  constant  wind  w  =  [if  ,0,0]^  to  another  point 

X/=[(C+^)C’0’-^T  (4) 

at  ^  ( Vl  is  the  estimate  of  a  steady-state  horizontal  speed 

and  is  the  desired  final  approach  time  ).  Figure  3 

shows  the  portion  of  a  guided  descent  we  would  like  to 
optimize  (shown  with  two  vertical  lines)  that  occurs  between 
some  turn  initiation  (TI)  point  at  altitude  Zq  (defined  by  the 
estimates  of  W,  and  the  components  of  the  ADS  velocity 
vector)  and  final  approach  capture  (FAC)  point. 


Hence,  we  need  to  find  the 
trajectory  that  satisfies  these 
BC  along  with  the  constraint 
imposed  on  the  control 
(heading  rate),  , 

and  allows  completion  of  the 
maneuver  in  exactly 

At,  (5) 

turn  jp.*  app  \  y 

(  V*  is  the  estimate  of  a 


steady-state  descent  rate).  The  optimal  control  y^^pAt)  that 
does  the  job  is  then  to  be  tracked  by  the  ADS’  GNC  unit. 
Obviously,  the  unaccounted  winds  {h)  =  ] 

will  not  allow  exact  tracking  of  the  calculated  optimal 
trajectory.  Therefore,  the  optimal  trajectory  needs  to  be 
constantly  updated  during  the  final  turn,  each  time  starting 
from  the  current  (off  the  original  trajectory)  IC  and  still 
forcing  the  ADS  to  be  at  (4)  within  an  updated  (5). 


Let  us  start  from  the  simplest  kinematic  equations: 


W  +  vl  cos  y/ 
vl  sin  y/ 


(6) 


From  these  two  equations  it  follows  that  if  the  fmal-tum 
trajectory  is  given,  the  yaw  angle  along  this  trajectory  is 
related  to  the  change  of  inertial  coordinates  as  follows: 


y/  =  tan 


y 

x  +  W' 


(7) 


Differentiating  this  equation  provides  with  the  yaw  rate  control 
required  to  follow  the  reference  fmal-tum  trajectory  in 
presence  of  a  constant  wind  FV: 

y(x  +  IF)  -  xj 


(x  +  IF)'+/ 


(8) 


Now,  following  the  general  idea  of  IDVD  we  will  assume 
the  solution  of  the  TPBVP  to  be  represented  analytically  as  the 
functions  of  some  scaled  abstract  argument  f  =  e  [0;  1]  as 
x(t)  =  F^(t)  and  y(T)  =  F^Ct)  ,  with  F^(t),  rj  =  1,2  being: 


F^{t)  =  al  +  a^z  +  a^T ^  +  a^z^  sin(;rr )  +  bl  sin(2;rr )  (9) 


The  coefficients  0^  and  b^  in  this  formula  are  defined  by 
the  BC  up  to  the  second-order  derivative  at  f  =  0  and  z  =  \. 
According  to  the  problem  formulation  and  Eqs.(3),(4),(6)  these 
BC  are  as  follows: 


X 


(v:+w)tt 


y_ 

PS 

_ 1 

1 

o 

II 

It- 

-  r  = 

1 

_ 

0  J’ 

X 

vl  cos y/Q-W 

X 

1 - 

1 

1 

1 _ 

_y_ 

r=0 

K  sin  1/^0 

_y_ 

f=i 

0 

(10) 


X 

X 

'O' 

.T_ 

T=0 

.ni^Aosn  J’ 

_T_ 

f=\ 

0 

Note,  while  TC  (10)  will  be  permanent  (the  second-order 
derivatives  are  zeroed  for  a  smooth  arrival),  the  IC  will  reflect 
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the  current  state  of  the  system  at  each  cycle  of  optimization. 
The  mapping  between  the  virtual  domain  [0;  ]  and  physical 

domain  [0;^^]  is  carried  using  the  speed  factor  (2)  as 
described  in  [11]. 

Differentiating  Eqs.(9)  two  times  with  respect  to  t 

+  la^f  +  3a^T^  +  Trb^  cos(;rr )  +  iTrb^  cos(2;rr ) 
T^fP^Xz)  =  2al  +6alT  -Ti^b'l  - {IttY b^  sin(2;rr) 

and  equating  these  derivatives  at  the  terminal  points  to  the 
known  BC  (10)  yields  a  system  of  linear  algebraic  equations  to 
solve  for  coefficients  a!  and  b]  (for  each  chosen  value  of  a 
single  varied  parameter  zj)  [11].  Applying  Eqs.  (7)  and  (8) 
yields  the  time  history  of  a  single  control  {//{h) . 

When  solving  this  problem  numerically  over  a  fixed  set  of  N 
points  (7  =  1,..., A),  spaced  evenly  along  the  virtual  arc 


[0;  Zf  ]  with  the  interval 

^z  =  Zf{N-\r\  (12) 

all  states  and  control  are  found  at  these  nodes,  so  that  the 
TPBVP  is  reduced  to 

min  J  subject  to  A  <  ^  , 


(13) 


where  the  performance  index  is 


J=  (14) 

VM  y 

(time  intervals  corresponding  to  Ar  are  found  via 

mapping  between  two  domains  [11]),  the  penalty  function 

\2 


A  =  max 

j 

and  s  is  some  tolerance. 


(15) 


ADS  Prototype  and  Real  Drops  Results 

This  section  presents  the  latest  results  of  employing  the 
aforementioned  IDVD-based  algorithm  on  a  miniature  1 .95kg 
ADS  Snowflake  (Fig.4),  featuring  0.85m^  (1.37m  span)  two- 
skin  canopy  and  capable  of  carrying  1.8-2.2kg  payload  [13]. 

Deployed  from  an  aircraft  or  helicopter  (so  far  from  as  high 
as  3km)  this  ADS  exhibits  the  following  performance:  the 
descend  rate  of  ~3.6m/s,  forward  speed  of  ~7.2m/s  (glide  ratio 
of  2:1),  and  minimum  turning  radius  of  about  15m. 


Fig.  4.  Snowflake  ADS. 


0 


Fig.  5.  Overall  performance  of  Snowflake 
ADS  with  optimal  terminal  guidance. 


To  date  over  40  drops  of  the  developed  ADS  were 
successfully  fulfilled  and  Fig. 5  presents  the  overall  results  of 
the  most  recent  drops  that  occur  in  May  of  2009.  On  May  18^^ 
the  drops  were  performed  right  after  thunderstorm  with  a  quite 
turbulent  atmosphere  and  on  May  19^^  the  weather  was  more 
cooperative.  The  CEP  for  all  eight  drops  is  30.6m  while  for 
four  drops  performed  on  May  19^^  is  slightly  less  (26m),  with 
the  closest  ADS  landing  within  14.4m  from  the  target. 

For  more  detailed  analysis  bird-eye-view  trajectories  for  the 
best  and  the  worst  drops  (from  the  standpoint  of  touchdown 
accuracy)  are  presented  in  Fig.  6  and  7,  respectively.  The  first 
observation  is  that  compared  to  trajectories  presented  in  Figs.l 
and  2  all  Snowflake  ADS  trajectories  look  alike.  The  reason 
for  that  is  that  the  system  establishes  and  accurately  tracks  the 
inertial  trajectory  developed  based  on  the  target  location  and 
prevailing  ground  winds  [11]. 


-1 1 4.3931 1 4.3921 1 4.391-1 1 4.39-1 1 4.3891 1 4.3881 1 4.3871 1 4.3861 1 4.385 
Longitude 

Fig.  6.  The  most  successful  drop  (14.4m  accuracy). 


-114.388  -114.386  -114.384  -114.382  -114.38 

Longitude 

Fig.  7.  The  least  successful  drop  (89m  accuracy). 


Upon  exiting  a  deployment  platform  (phase  0)  the 
Snowflake  ADS  steers  towards  a  rectangular  loiter  area  (phase 
1),  loiters  to  manage  energy  and  estimate  winds  (phase  2), 
exits  loiter  area  (phase  3)  to  enter  a  downwind  leg  as  a  manned 
aircraft  would  do  (phase  4),  and  eventually  performs  a  final 
turn  /  final  approach  (phase  5  and  6,  respectively). 

During  the  last  portion  of  the  descent  the  optimal  guidance 
algorithm  described  in  the  previous  section  continuously  re¬ 
compute  the  reference  inertial  trajectory.  To  be  more  specific, 
problem  (13)  is  recast  as: 
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mini  w^J  -\-W2  a)  (16) 

(where  Wi  and  W2  are  some  weighting  coefficients)  with  no 
constraints,  and  solved  numerically  using  the  straight  forward 
golden  section  search  and  inverse  parabolic  interpolation 
algorithm  (based  on  the  MATLAB’s  fninbnd  function).  A 
16bit  80MHz  processor,  the  core  of  Snowflake  ADS’  GNC 
unit,  allows  computation  of  an  about  20-second  turn  maneuver 
with  N=20  in  only  10  iterations,  which  takes  as  little  as  0.07s 
all  together.  With  the  control  update  rate  of  0.25s  that  means 
that  the  trajectory  can  be  updated  as  often  as  every  control 
cycle!  In  practice  however  we  allow  tracking  errors  to  build  up, 
and  perform  re-computation  of  the  reference  trajectory  every 
10  control  cycles. 

The  question  is  what  made  two  drops  (presented  in  Figs.  6 
and  7)  to  be  so  different  regardless  the  fact  that  there  were  no 
changes  in  GNC  algorithm.  The  answer  is  -  winds.  To  this  end. 
Figs.  8  and  9  provide  with  the  winds  measured  within  a  few 
minutes  before  each  drop  (shown  in  Figs.  6  and  7, 
respectively),  and  projected  into  the  direction  of  the  intended 
landing.  As  seen  from  Fig.8,  for  the  most  accurate  drop  the  last 
wind  estimate  W,  provided  by  Snowflake  ADS’  GNC  at  68.3m 
altitude  above  ground  (AGL)  was  about  3.6m/s  while  the 
actual  downrange  component  of  the  wind  gradually  decreased 
from  about  5.8m/s  down  to  2.7m/s  at  the  ground.  On  the 
average  the  winds  were  about  0.8m/s  stronger  than  it  was 
estimated,  but  the  capability  to  re-optimize  the  maneuver  while 
descending  allowed  compensation  for  this  change,  so  that  there 
is  almost  Om  downrange  error.  Taking  into  account  22.5s  that 
took  ADS  to  land,  without  re-optimization  the  ADS  would 
land  about  1 8m  short  of  the  target.) 

For  the  least  accurate  drop  (Figs.  7  and  9)  the  last  wind 
estimate  W  of  2m/s  came  at  51m  AGL  but  the  actual  winds 
were  more  than  -3m/s  (tailwind)  all  the  way  down.  These 
-5.4m/s  unaccounted  winds  (for  a  20.5s  descent)  resulted  in 
89.3m  overshoot  (again,  without  re-optimization  we  would 
have  111m  overshoot). 


VI.  Band-Limited  Guidance 


For  the  sake  of  comparison  let  us  also  consider  a  somewhat 
similar  algorithm  for  the  terminal  guidance,  BLG,  developed 
by  Draper  Laboratory  [7].  As  opposed  to  parameterizing  the 
coordinates  as  in  Eq.(9),  the  BLG  is  reduced  to  parameterizing 
a  control,  heading  rate,  as 


¥'{h)  =  Y,¥'k 


,  sm(4) 


4 


(17) 


where 


4  = 


7r(h  -  kAh) 

Ah 


(18) 


(to  obtain  the  heading  rate  command  ij/^  Eq.(17)  needs  to  be 


multiplied  by  V*  ).  Specifically,  for  an  Airborne  Systems’ 


Megafly  ADS  (with  V*  -5ml s)  a  final  turn  and  approach 
maneuver  begins  at  exactly  800m  AGL,  followed  by  the 
application  of  full  brakes  (flare)  at  60m  AGL,  so  Ah  =200m 
and  M=A  were  chosen. 


Winds  aloft  (m/s) 

Fig.  8.  Wind  data  for  the  drop  depicted  in  Fig.6. 


Winds  aloft  (m/s) 

Fig.  9.  Wind  data  for  the  drop  depicted  in  Fig.7. 


Five  varied  parameters  y/l ,  which  represent  turning  rates  at 

consecutive  multiples  of  Ah  ,  are  defined  by  solving  the 
following  unconstrained  optimal  terminal  control  problem: 

min  J,  (19) 

where  J  is  comprised  of  a  weighted  sum  of  a  squared  miss 
distance  and  squared  heading  error: 

{{Xf  -x,f+  +  sin^  i  (^^  -  )  (20) 

( is  the  desired  final  heading).  Of  course  all  the  states  are 
to  be  computed  via  integration  of  Eqs.(6).  As  stated  in  [7], 
integration  of  the  kinematic  equations  is  done  in  fixed  point 
arithmetic  for  efficiency.  Using  the  simplex  search  Nelder- 
Mead  algorithm  (MATLAB’s  fninsearch  function),  for  the 
optimization  allows 
re-solving  Megafly 
final  approach 

guidance  at  IHz  rate 
(using  each  previous 
solution  as  the  new 
initial  guess).  With 
the  imposed  100 
limit  on  the  number 
of  iterations  per  IHz 
cycle  this  means  that 
convergence  to  an 
optimal  solution  is 


Fig.  10.  Example  of  a  flight  path  of  Megafly 
with  Draper’s  GNC  [7]. 
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obtained  only  gradually.  An  example  of  the  last  portion  of  a 
guided  deseent  is  presented  in  Fig.  10. 


VII.  Conclusions 

Let  us  now  eompare  the  two  different  direet  method 
approaehes.  Table  1  presents  the  results  of  a  side-by-side 
eomparison. 


TABLE  I 

Comparison  of  IDVD  and  BLG 


Characteristic 

IDVD 

BLG 

Computing  the  coordinates 

parameterized 
analytical  function 

via  integrating 
equations  of  motion 

Computing  the  heading  rate 

via  inverse 
dynamics 

parameterized 
analytical  function 

Satisfying  TC  on 
coordinates 

automatically 

via  optimization 
(Eq.(20)) 

Satisfying  TC  on  heading 

automatically 

via  optimization 
(Eq.(20)) 

Satisfying  TC  on  heading 
rate 

automatically 

not  capable 

Satisfying  IC  on  heading 
rate 

automatically 

not  capable 

Satisfying  the  control 

via  optimization 

automatically 

bandwidth  constraint 

(Eq.(15)) 

Number  of  varied 
parameters 

1 

5 

Minimization  engine 

fminbnd 

fminsearch 

Convergence 

guaranteed 

not  guaranteed 

Number  of  iterations  to 

10 

>100* 

converge 

Onboard  CPU 

16bit  80MHz 

unknown 

CPU  time  to  converge 

0.07s 

Is* 

*  -  means  if  converges  to  the  solution. 


As  seen,  the  BLG  method  ean  exaetly  limit  the  eontrol 
bandwidth,  while  IDVD  ean  only  do  it  indireetly  by  penalizing 
ij/ .  On  the  other  hand,  IDVD  allows  to  automatieally  satisfy 

all  BC  and  guarantees  fast  eonvergenee  (apparently  running  on 
a  mueh  less  powerful  eomputer  eompared  to  that  of  Megafly’s 
GNC  unit).  Moreover,  IDVD  approaeh  has  even  more 
potential  by  adjusting  the  TC  aeeording  to  the  eurrent  aeeuraey 
of  referenee  trajeetory  traeking  as  outlined  in  [14].  Both 
approaehes  allow  and  will  definitely  benefit  from  uplinking 
the  ground  winds  so  that  they  ean  be  aeeordingly 
aeeommodated  in  (6)  (see  [14]). 

VIII.  Conclusions 

This  paper  reviewed  different  eoneepts  used  to  guide 
autonomous  ADS  towards  a  predetermined  target,  and 
eoneentrated  on  the  two  most  prominent  ones  (IDVD  and 
BLG)  using  inertial  terminal-guidanee  trajeetory  optimized  in 
real  time.  Both  algorithms  utilize  the  major  property  of  direet 
methods,  redueing  the  optimization  spaee  to  a  eertain  elass  of 
predetermined  solutions,  but  pursue  different  eomputational 
paradigms.  Based  on  the  analyses  presented  in  this  paper  it 
seems  that  if  limiting  eontrol  bandwidth  is  a  priority  then  using 
BLG  may  be  justified.  Otherwise,  the  IDVD-based  guidanee  is 
more  robust  and  guarantees  a  better  aeeuraey  than  that  of 
BLG. 
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